void RF22Initialization()
{
  if (!rf22.init())
    Serial.println("RF22 init failed");
    // Defaults after init are 434.0MHz, modulation GFSK_Rb2_4Fd36
  
    rf22.spiWrite(RF22_REG_0D_GPIO_CONFIGURATION2, B00100011); //set GPIO2 to direct input, pullup
    rf22.setFrequency(458.5,0.01);
    rf22.setTxPower(RF22_TXPOW_20DBM);
    //rf22.setModemConfig(RF22::GFSK_Rb12Fd15);
    rf22.setModemConfig(RF22::GFSK_Rb38_4Fd19_6);
  
    pinMode(redLED, OUTPUT);
    pinMode(greenLED, OUTPUT);
  
    digitalWrite(greenLED, HIGH);
}

#if !defined(PPM_OUTPUT)
void servoInit()
{
  MyServos[0].attach(9);
  MyServos[1].attach(8);
  MyServos[2].attach(7);
  MyServos[3].attach(6);
  MyServos[4].attach(5);
  MyServos[5].attach(4);
  MyServos[6].attach(3);
  MyServos[7].attach(A2);
  MyServos[8].attach(A1);
  //MyServos[9].attach(A0);
}
#endif
